//============================================================================
// Name        : ThreadTesting.cpp
// Author      : Kellen Carey
// Version     :
// Copyright   : Your copyright notice
// Description : Hello World in C++, Ansi-style
//============================================================================

#include <iostream>
#include "MotorController.h"
#include "Vision.h"

//std::mutex mutex;
//std::condition_variable cv;

int main() {
	MotorController motorController;
	Vision vis;
	motorController.init();
	vis.init(motorController);
	std::thread mot;
	std::thread vi;
	while (1) {
		motorController.setMotion("W1");
		vis.setAction(CENTER_BALL);
		mot = motorController.createThread();
		vi =  vis.createThread(motorController);


		mot.join();
		vi.join();
	}
	sleep(10);
}
